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ABSTRACT 



A computer program for simulating submarine motion in 
six degrees of freedom is developed. The simulated 
submarine is given a capability of shifting ballast. An 
automatic pitch and depth control is designed for the 
submarine simulated using optimal control theory. With the 
depth and pitch in automatic control a trim error signal is 
developed by comparing the parameters of the plant to that 
of a linearized model. This error is used to implement an 
automatic trim control that shifts ballast within the 
submarine to achieve a neutral trim. 
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I* SUBMARINE CONSOLS 

' The subaarine control problem differs from that of the 
surface ship in that the submarine translation in three axes 
and rotation about each of these axes must be considered. A 
typical submarine implements control about these axes with 
the use of movable plane control surfaces, shifting of 
ballast water and the propulsion system. 

The submarine operates and is controlled in all six 
degrees of freedom. To maneuver, three sets of plane 
surfaces, the propulsion system, and a means of shifting 
ballast are used.* This thesis considered only control of 
the plane surfaces and the shifting of ballast water. In 
addition , of the three plane surfaces available only the 
fairwater planes and stern planes were automatically 
controlled, i.e. no automatic rudder. 'The three modes of 
control were depth, pitch and ballast control. Course 
control was not considered. ^ 

Depth control consists of the sensing of any error 
between ordered depth and pitch and the actual depth and 
pitch. The planes were used to implement the control and 
bring the submarine to the ordered depth and pitch thereby 
reducing the error to zero or near zero. 

Ballast control is the sensing of other than neutral 
trim of the submarine. Because of surrounding water 
temperature changes, taking sea water in the ship or pumping 
it out, the submarine may not weign the same as the volume 
of water it displaces. Also too much water forward or aft 
in the ship initiates a turning moment around the Y axis 
that will eventually have to be corrected by the planes. 
This condition must first be detected so a corrective action 
can be applied by shifting ballast within variable ballast 
tanks located inside the submarine. 
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The purpose of controlling depth is obvious. pitch 
control is required largely because it is coupled to depth 
control and it is sometimes desired to maintain pitch at 
other ■ tnan a zero angle. A means of ballast control is 
required to surface the ship, maintain depth under certain 
conditions, allow deptn control to be accomplished within 
the limits of the planes' capabilities and to reduce drag 
caused by a steady state non zero planes angle. The 
corrective action for the last two out of trim conditions is 
normally accomplished by use of a pump to shift water into 
or out of variable ballast tanks in the submarine. 

The method of achieving an automatic control was to 
first develop an automatic controller that maintained an 
ordered depth and pitch. The controller was to counteract 
external forces by movement of the fairwater and stern 
planes. These forces can be caused by an out of trim 
condition or by the ship dynamics which at different speeds 
would cause the submarine to cnange depth in varying degrees 
plus such things as sea state, etc. The controller designed 
is unique to the submarine considered in ref{l) but the 
method is general and may be applied to most situations. 
With the depth controller in operation the automatic control 
of ballast was then solved. Again the solution is unique to 
the submarine considered. Finally with all automatic 
controls in operation various runs were made to determine 
the capability of the system. 



However, before a 


controller design can 


be 


started a 


computer 


model of 


the submarine must 


be 


developed. 


Reference 


1 contains a 


FORTRAN program used 


by 


NSRDC. A 



program language that was more easily manipulated in terms 
of filters, integration routines, etc. was DSL. To use DSL 
the equations of motion would have to be solved. 
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II. ^I>II;IM h SUBMARINE IN A DIGITAL COMP UT ER 



A. EQUATIONS OF MOTION FOR A SUBMARINE 

The equations of motion in six degrees of freedom are 
derived by equating the summation of the forces and moments 
to zero. 

2T Forces=0 
2 : Moments=0 

Where the vector force 
F = d/dt Momentum 

=d/dt (mVe) = md/dt Ve 
m is the mass and Ve is velocity 
Ve = iU+jV+kW 

The direction of positive motion is indicated in fig. II-1. 



Moment = d/dt (Angular momentum) at the center of gravity. 
Moment = d/dt (iPIxx+ jQIyy + kRI zz) 



Where Ixx is the moment of inertia about the X axis etc. 
The direction of positive motion is shown in Fig. II-2. 

A simplified derivation cf the equations of motion is found 
in ref. 2. 

The equations are referred to the body, i.e. the origin 
of the coordinate system is located in the body and at the 
center of gravity. Figure II-3 is a submarine placed on the 
coordinate axis with arrows pointing in the direction of 
positive motion. In addition the movement of the rudder, 
stern planes and fairwater planes are also depicted on Fig. 
II-3 with the arrows shown pointing in the direction of 
positive motion. The specific equations of motion for a 
submarine were developed for NSRDC and presented in ref. 3. 
If the coordinate origin is put at the center of gravity 
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these equations become the the equations of ref. 1. The 

equations of motion for a submarine in six degrees of 

freedom are repeated from ref. 1 in the Appendix. For use 

in the computer programs that follow the equations 

containing I ,I and I had both sides of the equation 
X y z 

5 

divided by 1 , Where 1 is the ship length. In the 

3 

equations containing m, both sides were divided by \.P 
was assigned the value of 2. 

The equations contain forcing terms for the planes and 
rudder, shifting of ballast water and the propeller. The 
propeller ipput is a function fitted to a curve. It 
contains the command speed and actual speed as ratios. 
Normally there are different sets of coefficients for 
different propeller inodes such as backing, slowing down etc. 
The only mode considered was forward propulsion at a 
constant speed. It _Wjas._noted that the actual speed was 

always slightly lower than_, the ordered speed. Uc (command 

speed) and U (actua^speed) are-i.n ±eet_per_second. 

All angles are in radians. Mass is in slugs and 
distance in feet. 

B. COMPUTEH SOLUTION TO THE EQUATIONS OF MOTION 

To solve the resultant differential equations ref. 1 
partitions the equations into different sums. The equation 
for 0 contains no other acceleration term so it is solved 
separately. V,P and B equations all contain mutual 
accelerations so they are solved using Cramers Buie for a 3 
X 3 system. W and Q contain mutual accelerations so they 
are grouped and solved as a 2 x 2 system. 
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The approach chosen in this thesis was to solve the 
whole system of equations at once using Cramers Rule for a 6 
X 6 system. This was more methodical and the determinants 
were solved only once in the beginning of the program using 
the “INITIAL" capability of DSL. 

The general forjn of the equations is, using two degrees 
of freedom for an example 





K 


K 




M S+N 


M S+N 




1 1 
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To simplify the manipulation let 



= F 
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11 11 
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then by substituting with I 
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defining 
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1 1 
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1 2 
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Using Cramers rule tp solve for and , 
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Noting the cofactor of K = K and the cofactor of K 
^ 1 1 22 1 

-K etc. 

2 1 
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I cofactor K + I cofactor K 
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s A 
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The same general approach can be used for higher order 
systems with the number of cofactors taken equal to the 
number of variables to be solved. In the equations of 
motion I will be a number of time varying nonlinear 
functions. 

Reference 4 used the library subroutine DTEEM in 
modified form to solve similar equations for the CSMP 
language. This method was further modified to work with DSL. 
Six by six determinants were solved by the program to get a 
solution for the equations in the form of the previous 
paragraph. By substituting columns and rows of ones and 
zeros in the row and column where the variables I should be 
the cofactor was found. For example in a 3 by 3 case 
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0 
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22 3 3 
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K 

1 1 


0 


K 

3 t 
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1132 23 
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Program #1 was used to solve for the cofactors in this 
manner. Once the cofactors were found subsequent programs 
had the cofactors read in as constants. In the program the 
cofactors are constants ana the variable I is dependent on 
time and the dynamics of the submarine. 
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SUBMARINE SIMULATION 



The computer used for the simulation was the IBM 360/67 
located at the W.R. Churcn Computer Facility, Naval 
Postgraduate School. The programming language was the Naval 
Postgraduate School version of DSL/360. Computer program #1 
is a simulation of a submarine in motion at 15 knots. The 
coefficient values used are obtained in ref. 1. As was 
previously discussed the equations of motion are derived in 
the body fixed system. A trigonometric conversion of the 
velocities is used in the auxiliary equations (appendix) to 
transform the equations to the earth reference system with 
the origin at x(to), y(to) and z(to). 

Reference 1 contains several maneuvers used to check 
out the equations and coefficients. One maneuver is the 
vertical plane overshoot where the stern planes are 

0 0 
deflected to +20 when the ship is pitched to -5 the 

stern plane angle is reversed. Program #1 executes the same 

maneuver with fig. 11-4 and II-5 showing depth, pitch and 

stern plane angle. The results compared favorably with those 

of ref. 1. 

The original equations contained forcing terms that 
were to represent water being blown from the main ballast 
tanks. In the programs developed for this thesis the 
forcing terms represented water being moved in variable 
ballast tanks with the capability of shifting ballast 
between tanks or between any tank and sea . 

To control the trim of a submarine a means of shifting 
ballast water must be provided. For the computer simulation 
a trim pump must also be simulated. Also trim tanks must be 
positioned in the ship model. The position of the tanks was 
an arbitrary choice vith some traditional basis. The tanks 
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were positioned as indicated in fig. 



Many options are available in the shifting of variable 
ballast water. The options depend on the number of tanks 
and their individual purpose. To simplify the computer 
simulation the options will be decreased consideraoly . Only 
three tanks will be considered. The auxiliary tank is placed 
at the center of gravity and will be used to adjust any 
overall mass error. That is a weight differential between 
the snip and the water it displaces. The forward and after 
trim tanks will be used only to adjust ballast within the 
ship. The result will allow negative values for the content 
of a tank. Tne options are. 



1. Heavy- pump auxiliary tank to sea. 

2. Light- flood auxiliary tank from sea. 

3. Heavy forward- pump from forward trim tank to after 
trim tank. 

4. Light forward- pump from after trim tank to forward 
trim tank. 

Any ballast correction will be accomplished by first 
correcting the overall mass error then achieving a forward 
and aft trim. 

Using the pump from Program #2 with Program #1 the 
effects of shifting ballast was demonstrated in the 
following simulations. The planes are put at zero and not 
moved during the run. Figure II-7 is the resultant pitch 
change when 2000 pounds of ballast is flooded into the 

auxiliary tank at a rate of 3860 lbs. /min. Because of the 

0 

ship dynamics a 2.7 up angle is taken even though the 

auxiliary tank is located at the center of gravity. With 

the planes left at zero the pitch angle remains constant at 
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this angle, (figure 11-8^ produces a surprising result, with 
2000 pounds ^f-looded in the ship went up 240 feet in 3.5 
minutes. (A negative number for depth indicates up and a 
positive number indicates down.) However keeping in mind 
that the submarine assumed an up angle the resultant depth 
change makes more sense. Figure II-9 was plotted with 
ballast pumped out of auxiliary tank to sea. The ship 
0 



assumes a .9 degree up angle. The depth is seen in Fig. 
11-10 to change by 135 feet in 3.5 minutes. Figure 11-11 
helps to resolve the apparent problem. In fig. 11-11 no 
ballast was transferred yet the ship assumed an up angle of 
significant degree with the planes on zero. Reference 5 
explains that most military submarines will generate a 
positive pitch due to the ship structure if the planes are 
zeroed. The submarine in ref. 1 is fictitious and the 
coefficients were randomly selected but it still appears to 
have some of the expected characteristics. Finally fig. 
11-12 and 13 were generated with ballast shifted from after 
trim to forward trim. 



The model performed as expected and the trim pump and 
planes produced the desired result. The next problem solved 
was the desi,gning of automatic controls. 
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Figure II-l 
Axes Definitions 
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Figure I I -2 
Axes Definitions 
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Figure I I -3 Submarine Axes 
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Depth vs. Time 
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Figure I I -5 

Curve 1, Stern Plane Angle vs. Time 
Curve 2, pitch vs. Time 
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Figure II-7 
Pitch vs. Time 
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Depth vs. Time 
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Pitch vs. Time 
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Depth vs. Time 
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Figure 11-12 
Pitch vs. Time 
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III. AUTOMATIC PITCH AND DEPTH CONTROL 



A. OPTIMAL SOLUTION TO THE LINEARIZED SUBMARINE 
EQUATIONS 

Automatic depth and pitch control can be achieved by 
various methods. For example, because of the fairwater 
planes having minimal effect on pitch a frequently used 
combination is to control the depth with the fairwater 
planes and pitch with the stern planes. Another way is to 
set a fixed ratio between stern planes angle and fairwater 
planes angle. In this case pitch is not "controlled" but is 
used to achieve ordered depth and the planes are used to 
change pitch. The approach selected in this thesis was to 
let the planes individually achieve what ever angle was 
required to meet an optimal control based on a cost function 
to be described later. 

Because of the nonlinearity of the equations of motion 
a linearized model was required to solve the equations 
required for an optimal control system. The required gains 
were then determined using the linearized equations. 
Linearizing the equations about some operating point was 
found to be impractical because the operating point can not 
be constant and the nonlinearities in the equations present 
a formidable problem in taking derivatives. Linearization 
was accomplished by dropping all nonlinear terms with the 
following justifications. Referring to appendix A all terms 
involving VJi are dropped because the linearized model is in 
trim. N’=1 because Uc=U. U is a measured quantity and the 
only terms of interest are W and Q, i.e. the problem is 
reduced to two degrees of freedom. The last result is 
obtained because only the depth and pitch are parameters to 
be controlled. Simple truncation of the equations of motion 
will eliminate the other nonlinear terms. The linearized 
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equations of motion are as follows 
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The values of the inverted matrix are constants and 
when solved for can be directly substituted as constants. 
The equations were then written in a acre general form that 
would lend itself to coding for a digital computer program 
as follows- 



■" ~ 
















- 










A 


A 




w 




B 


3 




Ds 






1 1 


2 1 








1 1 


2 » 








= 




















* 

Q 




A 


A 




Q 




B 


B 




Db 






1 2 


22 








12 


22 






— -1 














„ 






_ 



32 



let 



DetermfC (ly-Mg) (m-Zw)-Hw Zq J 



then 

^=[ (ly-Hq) Zw+Zg Mw.jU/lDeterm 

2 

A^^=£ M«Zw+ (m-Zw) Mw ]U/1 Detecm 

A^^=[ (ly-Hq) Zq+Zq Mq.]CJ/Deterai 

A^^=[ MwZq+ (m^Zw) hq jU/lDeterm 

2 

B^^=[ (ly-ilq) Zds+ZqMds ]U /iDeterm 

2 2 

B^^=[ HwZds+ (c-Ztf) ads JU /I Determ 

2 

B^^=c (ly-Hq) Zdb+Zq Mdb]U /IDeterm 

2 2 

B =f MwZdb + (ffl-Zw) Mdb JU /I Determ 
22 



The problem was treated as a linear tracking proolea 
with the control designed around the linearised model. The 
methods of ref. 6 were used for an optimal control with tne 
state equations in the general form 

X = AX + BU 

^ ~ /V /\/ 



which represents 
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A and B are as previously defined. 

♦sy /\/ 



The cost function to be minimized is 



.tf .j. j 

J=l/2 L[E QE + U 2U]dt 

^ /V> >s/ /N/ 



In the derivation of the optimal control equation the 
control returns the system to the origin. In this 
controller r was not restricted to the origin so X was 
equivalent to S where 



E = X - r 

^ /V' /*vy 



and r is the ordered deprh and pitch. A,3,Q,R, and r are all 

r\if r\f /Ny 

constant, X and U are time varying and the plant is assumed 

r>y /N/ 

to be completely controllable. (The last assumption was 
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supported by the solution results.) T is considered fixed 

f 

and X (t ) is free. The Hacniltonian is given by 
^ f 



T T T T 

Ham = 1/2£E QE + U SU] +p AX ♦ p BU 

r\J r\J r\J /%/ f\J /V /\/<^ ^ 



The costate equation is 



p =AHam/<^X 



/-V/ 



* ’i- *■ 
=-’QX^k p > Qr 

=-QE-A p* 

^ 



The asterisks indicate optimal controls and trajectories. 
The optimal control is then found by 



V V * ^ 

^Ham/c)U = EO + 3 p = 0 



* -1 T 

U =-E B p 

>N/ /V /V/ 





/ 



From ref. 5 the boundary conditions arc p (t ) = 0 

f 

defining p =KE 

^ ^/v 



taking the derivative of p and dropping the stars 
p =KE+KX 

^ /V /V />/ 
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by substitution 



p =KE + KX = -QE~k p 

^ /v/v /s/ /\J /sj 



. -I T 

X = AE-BB B p 

rJ /V r\j /V r>J rJ ^ 



p = KE 

V /V /V/ 



then 



. -IT T 

K=“KA + KBS B K - Q - A K 

mj a / a / r>J f\J /%/ aJ aJ ^ 



and 






-1 I 

U =-E B p = 



/%/ 



-1 T 

-fi B K£ 

/%✓ A^/V/ 



As described in ref. 



5 K(t ) = 0.0. K is symmetric i.e. 
^ f 



K =K etc. so n(n+l)/2 differential equations must be 

12 21 

solved where n=4. The solution of the differential equation 
for K will provide the optimal gains for U. 



Eeferring to the original equations and putting them in 
state variable form 
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R and Q are the weighting matrices. 



The following equations result from the 
manipulation . 



matrix 
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Since only the value of K <t ) is known these equations 

f 



must 
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To do this let 



be solved backwards i.e. from t to t . 

f 0 

r =t -t 

f 

d'^= -dt 

when *'^-0 

K = dK/dt = “dK/dr 

/\j /\y 



The signs of all the eguations are reversed and the initial 
conditions are those conditions at t^. Up to this point the 

solution is general and when solved the solution will 
provide gains for 
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The calculations of the gains that follow apply only to 
the submarine in ref. 1. The submarine described in ref, 1 
is fictitious and used for demonstration purposes only. DSL 
again is used to solve for the gains. The program used is 
program #2 which also contains the controllers designed in 
the following sections. 



PrograjB #2 first calculates the steady state gains used 
in the ccntroller. Khiie the gains are calculated the ship 
simulation is held at zero. After a specified time the 
simulation starts with the gains determined by the specified 
weighting matrix. 



Selection of the weighting matrix to be used can be 
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started off with some judgment as to the severity of 
different errors. For instance the ^itch eguations are in 
radians and the depth equations are in feet. It is obvious 
that a one radian pitch error is more severe than a one foot 
depth error. This immediately would lead to a higher weight 
on the pitch error signal. It was found that if too much 
emphasis was placed on pitch the depth error in steady state 
would become unacceptable . This lead to a trial and error 
process to select an acceptable weighting matrix combination 
that would give the desired results. 

To operate as an optimal controller the gains would 

have to be generated on line. This would require a 

significant computer capability. In an infinite duration 

process the gains would be constant as demonstrated in fig. 

III-l through 7. The optimal control can then be 

approximated with a steady state gain if the control 

interval is long with respect to the decay time of the 

optimal gains. Figure III-l through III-7 indicate a 

relatively short rise and fall time for the gains just 

before t . 

f 

As determined by observing the equations for K the 

gains are functions of the velocity U. A number of 

different runs were made at different velocities and the 
following approximate proportionalities were observed. 

a 

K ,K and K are inversely proportional to U . K ,K , 

14 23 34 J r IT 22 24 

3 

and K are inversely proportional to U . The runs were 

44 

made at 25.33 feet per second so the following adjustment 

~ y' 

was made to the gains used in the programs. 
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The new gains are given by ZM1 through ZM7. The B matrix 
2 

contains U so a cancellation of U takes place in the final 
equation. 

B. AUTOMATIC PITCH AND DEPTH CONTROL 

Figure III-8 and III-9 were simulations with C=1.0, 
D=100.0 and E=1.0 or the control input was weighted to 1.0, 
the pitch error was weighted to 100.0, and depth error 
weighted to 1.0. The ordered depth change was 10.0 feet. The 
controller initiated the proper planes but because the pitch 
was so large when ordered depth was achieved the overshoot 
pushed the control system into instability. Also the ship 
pitches in the wrong direction. The initial plane response 
is to a depth error and both planes were positioned as seen 
in fig. III-10. The ship pitched up witn an angle too large 
to overcome. 

The next run was made after weighting the pitch and the 
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control input more heavily. The weighting matrix used was 
C=10.0, D=300.0, and E=1.0. Figure III-11 is the resultant 
depth change for a 10 foot step input in ordered depth. The 
resultant steady state depth error was .29 feet which was 
acceptable. As before the ship initially pitched up to 
0 

about 12 and then returned to a steady state angle of 

0 

+1.28 as seen in fig. 111-12. Figure III-13 shows the 
fairwater and stern plane angles used to achieve the new 

0 0 

ordered depth. The maximum -80 stern plane angle and -50 
fairwater plane angle are unachievable on a real ship and 
the rates of change of depth and pitch were unnacceptable. 
When a limit constraint was placed on the plane angles the 
system went into a limit cycle. The steady state error in 
pitch was large enough to prevent the txim controller in the 
next section from detecting a ballast change to any degree 

0 

of accuracy. Lastly the pitch variation of 12 was 
considered unacceptable for only a 10 foot depth change. 

Larger emphasis was required on pitch but this caused 
the plane angles to become larger and if the weighting on 
plane angles was increased the system became insensitive to 
either depth error or pitch error depending on the wexght. 
The problem appeared to be a result of the initial depth 
error. To limit this effect with a large step input the 
depth and pitch error were limited as shown in fig. Ill-lh. 
Also a larger emphasis was required on pitch error in the 
weighting matrix. The weighting matrix chosen was C=10.0, 
D=3000. 0, and E=1 . 0. 

In fig. III-13 a significant noise level is seen in 
the plane positions. To reduce this noise the plane angle 
ordered was filtered with a simple low pass filter. 

The tests were run again and this time a 20 foot depth 
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change was ordered. The magnitude of the saturation limit 
can be adjusted for different results . The values selected 

0 

for saturation were ± two feet for depth error and ± 10 for 
pitch error. Major differences to be noted in the runs are 
the reduced rate of depth change. A 20 foot depth change 

0 

took about 45 seconds. The maximum pitch assumed was -.8 
. The steady state depth error was .2 feet and the steady 

0 

state pitch error was . 14 . This run was plotted in fig 
III-IS, 16 and 17. 

The controller was tested for its ability to maintain 
depth. To check this the ordered depth was put at zero. 
The controller maintained a steady state depth error of .16 

0 

feet and a steady state pitch error of .14 as seen in fig. 
III-18 and III-19. The plane angles are presented in fig. 
III-20. Note that a steady state fairwater plane angle of 
0 

-4.0 was required to maintain depth. What this implies is 
that to run the simulated submarine at a zero pitch and on 
the ordered depth with zero plane angles, ballast would have 
to be added. 

The depth controller was also required to maintain 

0 

depth in a turn. A simulated rudder angle of 10 was 

added. The rudder motion is not restrained in rate for this 
simulation. After 50 seconds the rudder angle was put to 
zero. Figure III-21 plots the roll developed as a result of 
the manipulation. The transient in pitch and depth was small 
as indicated in fig. III-22 and 23. In particular fig. 
III-24 shows a positive fairwater and stern plane angle 
required as the submarine settles in the stern. 

In early runs it was apparent that the submarine was 
"light" and ballast should be added. This was based on a 
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s 



0 

steady state fairwater plane angle of ai)OUt -4.0 with a 
near zero depth and pitch error. In the following run 
ballast was added to the auxiliary tank at about 8000 pounds 
per minute for 2 minutes while the planes were in automatic 
control. Figure III-25 and 26 show a steady state depth 

0 

error and pitch error of about -.02 feet and .04 as 

0 

compared to .16 feet and .14 with out the ballast. Also 
the steady state fairwater plane angle. Fig. III-27 , shows 

0 0 

a steady state angle of about -1.5 compared to -4.0 . 
This confirms that ballast should be added to run the ship 
in "trim". 



The depth controller was operating satisfactorily with 
a controller that is somewhat less than optimal for large 
transients and near optimal for small transients. The last 
problem to solve was to determine ballast error in the 
submarine and correct it. 
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IV. AUTOMATIC TRIM CONTROL 

A. METHODS OF TRIM CONTROL 

A continuous monitoring and control of the submarine 
trim is required. A submarine that is "heavy" runs with the 
fairwater planes on a constant positive angle. If the 
submarine is too heavy the fairwater planes angle reaches 
saturation and a large positive pitch is required to 
maintain depth. The speed of the submarine along with the 
angle of inclination of the planes determine the lifting 
force developed by the planes. At a high speed a submarine 
that is "heavy" may be well within the control limits of the 
planes. When the speed is decreased the decreased lifting 
forces would cause larger plane angles to be ordered until a 
possible saturation of the planes could occur. A submarine 
at any speed with a constant steady state fairwater or stern 
planes angle is experiencing a drag that is reducing the 
efficiency of the propulsion plant. These conditions must be 
corrected to efficiently operate the submarine. 

Two options for automatic trim control were considered. 
One was to determine the steady state lifting forces caused 
by excessive ballast and display the magnitude of the 
ballast error allowing a manual correction. The next was an 
automatic controller in the loop pumping or moving ballast 
as needed to maintain trim. 

The first option would be accomplished by solving the 
linearized equations developed in previous sections in the 
form 



Force=AW + EQ + CDs + EDb 
Homent=AW + BQ + CDs + EDb 
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where in the steady state, if the plane angles are non zero 
the forces and moments are equivalent to the weight of 
required ballast to be moved. This option was not explored. 

The second option was accomplished using a model 
following technique. The velocities of a linearized model 
running in a computer and those of the submarine are 
compared as in fig. IV-1. Both the model and the plant have 
the same plane angle inputs. For zero plane angles and 
operation on ordered depth the velocities in the vertical 
direction and around the Y axis for both the plant and model 
are zero. Perturbations caused by the planes to achieve a 
new ordered depth should cause both the plant and the model 
to accelerate in the same direction. However if a steady 
state plane angle is required to maintain depth or pitch in 
the submarine these plane angles represent accelerations in 
the model. A comparison of the submarine which is at nearly 
zero velocity and the model which is accelerating would 
indicate a ballast differential between a model in “trim” 
and a submarine out of "trim”. There will be some error in 
the model but for small perturbations the error should be 
small. The model actually used was the same as used in 
previous sections for the derivation of the depth 
controller. 

The need for the watch officers to maintain absolute 
control of the ballast shifted in or out of the ship would 
prevent an automatic trim controller from working in other 
than a passive override mode. In this mode the controller 
signals the operator that corrective action must be taken to 
maintain the proper trim. The operator, if conditions 
permit will actively allow the controller to perform its 
task. With no action on the part of the operator the system 
would not operate. 
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MODEL COMPARISON FOR TRIM CONTROL 



In all the simulations that follow the velocities used 
are W and Q. The error resulting is small as long as pitch 
and roll are small. It was observed that with automatic 
control the pitch was kept relatively small. The effect of 
the roll will be discussed later. All runs are made with 
the submarine in an automatic depth control mode. 

To get an idea of the magnitude of the velocities 
involved the first runs consisted of comparing the model and 
submarine velocities in the W and Q direction while manually 
initiating a shift of ballast. In fig. IV-2 ballast was 
pumped into the auxiliary tank. The bottom curve is the 
fairwater planes angle which moved towards a zero position. 
This is the same result observed in the previous section. 
The top curve is the stern planes angle and the middle curve 
is 10 rimes the velocity error. The error signals are 
multiplied to fit them on the same plot as the planes. Note 
that the velocity error crossed zero at approximately the 
same time as the fairwater planes were at zero. This was 
the desired response to adjust trim for a zero fairwater 
plane angle. 

This simulation run was repeated, this time ballast was 
shifted from after trim tank to forward trim tank. In fig. 
IV-3 the fairwater planes angle and stern planes angle, 
curve 1 and 2, were adjusted to overcome the turning moment 
caused by the ballast shift. Curve 3 is 2000 times the 
velocity error in the Q direction. This curve crossed zero 
at about the same time as the stern plane angle crossed 
zero. This was the desired response for a zero stern plane 
angle when the suomarine was in "trim”. 

The controller used was an on-off controller. The pump 
operated at a fixed rate. The error detectors were to sense 
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an erro;:, determine the direction of the error and then 
operate the pump. To prevent the pump from operating 
continuously a deadzone was inserted in the error signal 
channel. the deadzone was used to limit cycling of the pump 
during transients but its magnitude was constrained by the 
plane angles allowed in steady state. Adjustment of the 
deadzone would also determine the frequency of pump cycling 
and the steady state accuracy. 

In fig. IV-4 the vertical velocity error and the steady 
state accuracy were plotted with a history of maneuvers as 

0 

follows. At time zero the rudder was put at a left 10 , in 
50 seconds it was moved back to zero. At 100 seconds the 
depth ordered was -20.0 feet. The peak observed at time 70 
seconds would prevent any fine control of trim. This peak 
was the result of the settling of the submarine in a turn as 
observed in i^revious sections. The settling or squatting is 
compensated for with plane angle and these plane angles 
accelerate the model. This is not a serious poblem and can 
be solved in a number of ways. One way would be to increase 
the degrees of freedom in the model. This would of course 
be a more difficult model to construct in a computer. 
Alternately the system can disengaged in a turn. This would 
reduce the capability of the system by a small degree. 
Since the time spent in actually turning is small 
disengaging night be the best course of action. For use in 
this thesis it was assumed that this second course of action 
was taken. The deadzones were then selected at .0008 
radians/second for rotational velocity error and .08 
feet/second fcr verical velocity error. 

The controller had two separate modes. One was to move 
ballast in and out of auxiliary tank to sea. The other was 
to move nallast between forward and after trim tanks. These 
modes were first checked out separately. First the 
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ballast the pump was shifted to pump from auxiliary for 79 
seconds. At this point the controller stopped pumping out 
of the auxiliary tank and again pumped from after trim to 
forward trim for 20 seconds and then the pump stopped. 70 
seconds after the pump stopped it started and pumped for 20 
seconds out of the auxiliary tank. The end result on the 

0 0 

steady state angle of the fairwater planes was .6 and .2 
on the stern planes. figure IV-9 shows the tank levels as 
ballast is moved to achieve a neutral trim. Figure IV-10 
and 11 plot the planes angles. Tne planes move toward a 
zero steady state angle and a neutral trim is approached. 

To denomstrate the effect of the deadzone the vertical 
velocity error deadzone was reduce to .04 feet/second from 
.08 feet/seccnd. Figure IV- 12 is the tank levels where the 
initial out of trim condition was the same as for fig. IV-9. 
A comparison of fig. IV-10 and 11 with fig. IV-13 and 14 
shows the steady state planes angles were closer to zero 
with the smaller deadzone. Figure IV- 15 and 16 show the 
depth controller while ballast is shifted. Pitch is 

0 

controlled to .02 error and depth to a . 1 foot error. 

When the ship was ordered to change depth by 20 feet 
with the ship in trim the model followed closely enough so 
that no pump commands were given. 

An additional feature in the system was tested. On 
some maneuvers it is desirable to operate the submarine 
"heavy”. This is normally accomplished by simply adding for 
example 5000 lbs to the auxiliary tank. Whether or not the 
submarine is actually 5000 lbs heavy depends on the initial 
state of the trim. If the submarine is initially 2500 los 
light it is now only 2500 lbs heavy vice the desired 5000 
lbs. By adding a weight forcing term to the model in the W 
equation and assigning a value to this forcing term when the 
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heavy or light conditon is desired the pump will shift water 
into or out of the auxiliary tank until the desired 
condition is reached. The accuracy of accomplishing this is 
determined by the deadzone in the vertical velocity error 
signal. For the submarine simulated a value of .02 
feet/second worked nicely. 

The program used for the simulation is program #2. Once 
the gains and cofactors are determined they can be read into 
the program as parameters and the subroutines and Riccati 
Equations (gain equations on page 38) can be removed. The 
controllers with filters as used is shown in fig. IV-17. 
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Figure IV-1 

Comparison Block Diagram 
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Figure IV-1 

Model Comparison Block Diagram 
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Figure IV-2 

Cvirve 1, Fairwater Planes Angle vs. Time 
Curve 2, Stern Planes Angle vs. Time 
Curve 3 j Vertical Velocity Error vs. Time 
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Figure IV -3 

Curve 1, Falrwater Planes Angle vs. Time 
Curve 2, Stern Planes Angle vs. Time 
Curve 3> Rotational Velocity Error vs. Time 



81 



u> 



(.08 Feet/sec. )/lnch 




(WO ) ^ 

50 Seconds/inch 
Figure IV-4 

Vertical Velocity Error vs. Time 
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Figure IV-5 

Auxiliary Tank Level vs. Time 
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Figure IV-6 

Curve 1, Falrwater Planes Angle vs. Time 
Curve 2, Stern Planes Angle vs. Time 
Curve 3> Vertical Velocity Error vs. Time 
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Figure IV -7 

Forward Trim Tank vs. Time 
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Figure IV-8 

Curve 1, Fairwater Planes Angle vs. Time 
Curve 2, Stern Planes Angle vs. Time 
Curve 3 > Rotation Velocity Error vs. Time 
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Figure IV-9 

Curve 1, Auxiliary Tank Level vs. Time 
Curve 2, Forward Trim Tank Level vs. Time 
Curve 3 j After Trim Tank Level vs. Time 
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Falrwater Planes Angle vs. Time 
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Figure IV-11 

Stern Planes Angle vs. Time 
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Figure IV-12 

Curve 1, Auxiliary Tank Level vs. Time 
Curve 2, Forward Trim Tank Level vs. Time 
Curve 3i After Trim Tank Level vs. Time 
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Stern Planes Angle vs. Time 
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Figure IV-15 
Pitch vs. Time 
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Figure IV-16 
Depth vs. Time 
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V. CISCUSSION^ CONCLUSIONS REC OMME NDATIONS 
A. . DISCUSSION 

In the design of optimal controllers a major difficulty 
is in determining a weighting matrix that produces the 
desired response. With the use of computers many simulations 
can be made and the weights adjusted to obtain the response 
needed. In this thesis no attempt was made to weight the 
velocities with the errors. This is an option that could 
give more control over tne output response, but this would 
also greatly increase the difficulty in selecting the 
weighting matrices. 

The optimal controller designed gave excellent results 
and produced steady state errors that were smaller than can 
be normally measured. The magnitude of the error achieved 
is a function of the weighting matrix selected and the 
forcing inputs to the system. 

The depth controller was not designed as a depth 
changer, but as a regulator. However it did function for 
depth changing inputs. The depth changing rate was 
determined by a saturation limit in the depth and pitch 
error inputs . The limiter is required because the planes 
have a finite capability and the use of optimal control 
assumes an infinite control input is available. The 
saturation limit can be adjusted for different plane angle 
responses to large depth changes. This would change the 
rate of depth change and tne pitch angle assumed during the 
transient. The magnitude of the saturation limit chosen was 
based on limiting the planes angles when a new ordered depth 
was given and further study of any range of limits was not 
made. 
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Trim control was accomplished using a model comparison 
technique. The results of this technique were in some 
respects better than expected. The trim controller was 
accurate in the final results and its corrective action was 
achieved earlier than a manual operator could accomplish 
because the error was detected sooner. The model was run in 
two degrees of freedom. If the model is left at two degrees 
of freedom something must be done to compensate for the 
effects observed in a roll. The system would not reliably 
detect a change in trim in a turn and its ability to detect 
a change in trim during a large vertical transient is 
questionable. However, the controller would not mistake a 
vertical transient as a demand or need for ballast change. 
Because of this last result it was not necessary to 
compensate or change the system in a dynamic vertical 
situation. The trim controller was not based on the depth 
controller used so it would conceivably work with any depth 
controller as long as the planes were used to compensate for 
pitch and depth errors. Filters would be required to give 
continuous average plane angles. 

Using the trim controller to adjust the submarine to a 
"heavy" or "light" condition was not part of its intended 
function but the controller was able to accomplish this with 
reasonable accuracy. The accuracy was largely determined by 
the dead zone in the signal channel. The deadzone would have 
to be large enough not to mistake noise or ordered depth 
transients for a trim error. This contraint imposes a limit 
on the accuracy that could be achieved. The priority 
assigned in adjusting trim was arbitrarily assigned to first 
correct an overall weight problem then adjust for a fore and 
aft trim. 
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CONCLUSIONS 



Optima.1 control techniques can be used to design a 
depth controller that achieves a steady state condition as 
accurately as desired. Adjustment of the weighting matrices 
would emphasize those errors that are most important and 
also adjust the amount of response by the planes to 
accomplish the control. The insertion of nonlinearities (in 
this case a saturation limit) would allow the controller to 
give a reasonable response to any input and provide for a 
depth changing capability as well as the depth maintaining 
capability designed for. 

Steady state gains were used instead of time varying 
gains, and this did not degrade the functioning of the 
controller but did provide a significant simplification in 
the controller. A controller designed with the methods 
described would provide a vast improvement over manual 
operation. The gains provided are only a function of speed 
which makes realization of the controller relatively simple. 
The controller output itself is also a function of pitch 
rate and depth rate. This provides an anticipatory feature 
to the controller. 

In the past trim control has been purposely left to 
manual control. This was for safety reasons and because the 
detection of an out of trim condition was a matter of 
judgement based on the observation of plane positions and 
therefore only good in the steady state. The passive 
override mode discussed in previous sections removes the 
safety constraints in the use of an automatic trim 
controller. The simulations run demonstrate that detection 
of trim error can be accomplished accurately in a dynamic 
situation. The method still uses the planes positions for 
its determination but the lifting forces of both sets of 
planes and the turning moments of both sets of planes are 
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used in the determination of trim. Traditionally only the 
lifting forces of the fairwater planes and the turning 
moment of the stern planes were considered for the trim 
error estimate. The controller made accurate estimates as 
seen in fig. IV-9 and 12 where it was noted that the 
controller never had to go back and correct an adjustment 
once it was made. 

The additional feature in the trim controller of being 
able to deliberately order an out of trim condition provides 
for more positive control in the trim of the submarine. 
This control is a function of the actual submarine 
conditions and not of the assumed conditions. If the 
conditions change during the submarine operation such as an 
ascent the trim controller would automatically maintain the 
out of trim condition ordered. A difficult feat for a 
manual operator. 

C. RECOMMENDATIONS EOR FURTHER WORK 

There are six specific areas that need further study 
and work. They are enumerated in the following paragraphs. 

, 1. The selection of the saturation limits in the error 
channel was arbitrary and the only criteria was to prevent 
the planes angles from becoming excessive in a depth 
changing situation. As in the actual controller there must 
be some optimum limit that would meet a specific criteria in 
changing depth. this limit could be found using a function 
minimization program where numerous simulation runs are made 
and compared to determine a cost based on meeting the 
criteria specified. A minimum cost would define a match to 
the criteria specified. 

2. To achieve a zero steady state error and at the same 
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time make the controller an optimal depth changing 
controller a method of decoupling is needed. The methods of 
steady state state decoupling through the use of cascade 
compensators described in ref. 7 might provide such a 
controller with a function minimization procedure to meet a 
specified criteria. This approach would allow for zero 
steady state error in pitch and depth under most conditions. 

3. the controllers in this thesis were designed for 
continuous time. To provide for use in a time shared 
computer environment a discrete version of the controller is 
required. For the trim controller this would mean a 
discrete model used for comparison with the submarine and a 
sampling of the submarine parameters. 

4. The control inputs considered for the depth 
controller were the fairwater and stern planes. The control 
inputs could be expanded to include a vertical forcing 
function and a rotational forcing function around the Y 
axis. These inputs would of course be the shifting of 
ballast in the trim tanks. In this case the planes angles 
would be included as states. The purpose of this scheme is 
to control the planes to a zero angle by the shifting of 
ballast . 

5. The trim controller does not work in a turn. A 
suggestion to correct this would be to increase tne degrees 
of freedom of the model. The model would have to be 
developed and tested. 

6. Finally, the options allowed for the pump were very 
limited and for example if the submarine is "heavy" forward 
and at the same time "heavy" overall the designed controller 
would pump ballast from auxiliary tank then pump ballast 
from forward to aft. A more efficient maneuver would be to 
pump ballast form forward trim to sea. Even for only three 
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vaciable ballast 
significantly more 



tanks the pumping operation would become 
complica ted. 
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EQUATIONS OF MOTION 



The following sec of equations are referred to a body 
fixed system of axes which are coincident with the prln 
Clpal axes of Inertia of the body. T!ie origin of this 
axis-system Is located at the assumed center of mass of 
the bodv 



Equation of Motion Along the Body Axis System x-Axis 



m(u - vr + v/q)= I [x • q* + + X ' rp] 




+ -f [x 
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Equation of Motion Along the Body Axis System y-Axts 



m(v • wp + ur) = 
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EquaClon of Motion Along the Body Axis System z-Axls 
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Equation of Motion About the Body Axis System x-Axls 
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Equation of Motion About the Body Axis Systen y-Axis 
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liquation of Motion About the Body Axis System r-Axls 
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AUXILIARY EQUATIONS 



4> = p * Sind 
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NOMENCLATURE 



All symbols used In the equations of motion and in the 
auxiliary equations and relationships which appear In this 
report are defined below. Any dimensions involved will be 
consistent with the f oo t -p o»in d - sc c ond system of units. All 
angles are In degrees. The Fortran variables corresponding 
to these symbols arc shown In Appendix B 



SYMBOL 



B 



m 



Si 

u 



U 



V 



V 



DEFINITION 

A dot over any symbol signi- 
fies differentiation with res- 
pect to time. 

Buoyancy force which Is posi- 
tive upwards . 

Mass of the submarine Including 
the water In the free flooding 
spaces. 

Overall length of the submarine 

Linear velocity of origin of 
body axes relative to an earth- 
fixed axis system. 

Component of U along the body 
x-axls . 

Component of U along the body 

y-a X Is . 

« 

Component of U along the body 
x-axls . 
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Command speed: A steady value 

of u for a given propeller rpm 
wheno^jjB) and control surface 
angles are zero. Sign changes 
with propeller reversal. 

Longitudinal axis of the body 
fixed coordinate axis system. 

Transverse axis of the body 
fixed coordinate axis system. 

Vertical axis of the body fixed 
coordinate axis system. 

Distance along the x^ axis of an 
earth-fixed axis system. 

Distance along the axis of an 
earth-fixed axis system. 

Distance along the axis of an 
earth-fixed axis system. 

Component of angular velocity 
about the body fixed x-axls. 

Component of angular velocity 
about the body fixed y-axls. 

Component of angular velocity 
about the body fixed z-axls. 

The z^coordlnate of the center 
of buoyance (CB) of the subma- 
rine. 



I 



o< 


Angle of attack. 




Angle of drift. 


Sb , Dfa 


Deflection of bowplane (or ^ 

sailplane ) 


Sr ) Or- 


Deflection of rudder. 


Ss ; Dj 


Deflection of sternplane. 


f 

n 


The ratio ^ 


0 

C 


Pitch angle. 

Yaw angle. 

Roll angle. 

^^ass density of sea water. ^ 




Weight of water blown from a 
particular ballast tank Ident- ,/ 

Ifled by the Integer assigned 
to the index i. 


CO 


Angular velocity. 


t 


Time . 


^ti 


Location along the body x-axls 
of the center of mass of th^ 1^^ 

ballast tank when this tank is 
filled with son water. 
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I 



X 



Propulsion force (see auxi- 
liary equations and relation- 
ships) . 

Moment of Inertia of a sub- 
marine about the x-axls. 



I 



7 



Moment of Inertia of a sub- 
marine about the y-axls. 



I 



z 



Moment of Inertia of a sub- 
marine about the z-axls. 



Kp. Kp', Kpjp|',K<^^' 

k;. k.' k-'. k^p'. K,' 



Non-dimensional constants each 
of which is assigned to a parti- 
cular force terra In the equation 
of motion about the body x-axis. 



M, 



K • 
r r 



rp 



AM 



rp 



M, 



j q I 6s ’ 



Ml x\ M.', M M •, 

|w|q* V vr vp qn " 

M • , M I I ! M I I * , M ’ , M • , M. ' , 
V • W I W I I w 1 WW 



«6b'- ”vn-’* ”w|wln*'« »6sn* 



Non-d 1 me ns 1 on a 1 constants each 
of which Is assigned to a parti- 
cular force terra In the equatlcti 
of motion about the body y-axis. 
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N.'.N '.N.’.N’.N, I’.N, 

r p<j p r |r|6r |v|r 



N'.N.'.N ',N 

p • V wp * rn' ’ * • V ’ 



**vlv|’' ^«r’’ ^ 4 rn’’' ^’vn*’’ ^v|v!n’’ 



Non-d Incna Iona I constants each 
of which Is assigned to a parti- 
cular force tern In the equation 
of motion about the body z-axls. 



X \ X \ X \ X.\ X ',x 
qq rr rp u vr wq ’ 

X’X’.X’X *X * Non-dl mens Iona 1 constants each 
uu vv ww 6 r6 r 6 s6 s * 

of which Is assigned to a parti- 

Xj..,.', X X X, ^ cular force term In the equation 

0 b6 b vvn wwn 6s63n 

of motion along the body x-axla. 



^6x6 rn * 



^p’* %q’- ^pIpC ^p’. 



Mr!'* ^|rl4r*‘ ^n * ’ * 






\n'*« %Mn-’* ^Vvs 



Non-d Imcns Iona 1 constants each 
of which Is assigned to a parti- 
cular force term In the cquatlo 
of motion along the body y-axls 




Non-d Imen s Ion a 1 constants each 
of which Is assigned to a parti- 
cular forco term in the equatio- 
of motion along the body z-axls 
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